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Spectra Precision AB 

Anordning och forfarande for att bestamma laget for en bearbetande del 

5 

Foreliggande uppfinning avser en anordning av det slag, som anges i ingressen till 
patentkravet 1, och ett forfarande av det slag, som anges i ingressen till patentkravet 
14. Uppfinningen avser speciellt styrning av en arbetsmaskin, tex. en markutjam- 
ningsmaskin, lyftkran, mudderverk e.d. 

# 

UPPFINNTNGENS BAKGRUND 

Vid vagbyggen eller planlaggning av mark t.ex. infSr bebyggelse, park eller lekan- 
laggning, fordonsuppstallning e.d., anvands markberedningsmaskiner, som skali ge 
15 en fbrbestamd topografi hos ett markomrade genom dels gravning och dels palagg- 
ning av material. 

Det ar harvid viktigt att de bearbetande verktygen pa de verktygsmaskiner, som 
anvands, noggrant kan styras till exakt ratt bearbetningsniva vid avsedda delomraden 
20 i naturen. Styrningen skall heist aven kunna fjarrstyras automatiskt, sd att den 

onskade topografi en i ratt piacering inom ett omrade skall kunna skrivas in i ett 
" - - ' dataprogram, och upplysningar betraffande lamplig bearbetning skall kunna ges 

. : . lopande och automatiskt till fordonsfbraren. Det skall aven, dar sa ar mqjligt, kunna 

. - ; - . ges en automatiskt styrning av verktygsmaskinen for att utfora viss bearbetning helt 

:* = ": 2 5 automatiskt. 
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Detta innebar att man for markbearbearbetande verktyg vill halla reda pa det exakta 
laget for deras arbetsredskaps position i rummet, vinkellage i bade horisontal- och 
vertikalriktning samt deras arbetsriktning. 



BESKRJVNING AV BESLAKTAD TEKNIK 



US-A-4,807,13 1 (Clegg Engineering) beskriver ett markberedningssystem med 
anvandning av ett instrument med en horisontalplan-identifierande roterande 
svepstrale, och en pa en markberedningsmaskin placerad hojdindikator for traff av 
svepstralen. Hdjdindikatorn ar placerad direkt pa maskinens bearbetande verktyg, 
t.ex. pa bladet till en gravskopa. Dessutom kan en separat positionsgenerator vara 
placerad pi maskinen och samverka med ett elektroniskt distansmatande instrument 
for att ge maskinens position i det omride, som skall bearbetas. Signalerna frin de 
olika ovan namnda indikatorer matas till en dator, som far uppgift om Onskad 
topografi hos markomridet via forbestamda, sammansatta data, sammanstaller 
matvardena och ger indikation for styrning av maskinens bearbetande verktyg. Detta 
arrangemang med positionssensorn pa maskinen och hojdsensorn pa bladet loser ej 
problemet att bestamma bladets position i ett fast koordinatsystem vilket aven 
papekas i US-5, 6 12,864 (Caterpillar Inc). Enligt detta patent loses problemet genom 
att tva positionssensorer placeras pa bladet, varvid bladets lutning i ena riktningen 
relativt maskinen mats med en vinkelsensor och maskinens orientering extraheras ur 
matdata tagna under maskinens rorelse. 

Att placera positionsdetektorer pa bladet innebar dock tvi stora nackdelar: 
A. Detektorn eller detektorerna skyms ibland av maskinen om de inte placeras 
pi hoga master vilket minskar noggrannheten och tillfbrlitligheten. Detektorn 
eller detektorerna miste ju kunna samverka med en m&tstrale hur maskinen an 
kan tankas vrida och vanda sig under arbetets gang. 
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B. Detektorn eller detektorerna blir mycket utsatta for averkan under bearbet- 
ningen, smuts, vibrationer, mekanisk averkan etc. 

Att bestamma orientering och lutning via maskinrorelserna ar dessutom en langsam 
5 metod och ej heller entydig om maskinen kan backa eller forflyttas i sidled. 

Likasa ar positions- och hojdbestamning med GPS-teknik eller med elektroniska 
vinkel- och distansmatande ofta ej tillrackligt snabb for att kunna mata in position 
och framfor allt hojd med tillracklig noggrannhet vid snabba forflyttningar. 

^ 10 Det firms andra typer av system, som avser fjarrstyrning av en eller flera maskiner pa 
en arbetsplats med hjalp av flera geodetiska instrument. Varje instrument kan 
automatiskt stalla in sig mot och folja en reflektor och ger information om avstand 
och vinkeilage i bide vertikal och horisontell riktning mot reflektorn. Dar galler det 
att den markberedande maskinen skall fa lagesinformation av enbart ett av distans- 
15 matinstrumenten. Det galler da att diskriminera bort informationen fran de ovriga. 

Den internationella ansokningen WO 95/34849 (Contractor Tools) beskriver ett 
sidant system, dar man har en horisontell ring av reflektorer och styrbart kan utnyttja 
enbart den reflektorn, som ar inriktad mot det distansmStinstrumentet, som skall 
^20 utnyttjas i varje givet ogonblick. Enbart maskinens koordinatposition mats upp. 

. : . : Den internationella ansokningen WO 95/28524 (Caterpillar) visar styrning av ett 

: flertal markberedningsmaskiner, dar den aktuella positionen hos varje mas kin med 

: - hjalp av positionsgivande arrangemang, t.ex. en GPS-mottagare (GPS = Global 

25 Position System) placerad upptili pa varje maskin. En basreferensstation ar placerad 

i narheten av maskinerna. Styr- och korrektions information for maskinerna overfors 

meilan basreferensstationen och maskinerna. 
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UPPFINNINGENS SYFTEN 

Ett syfte med uppfinningen ar att astadkomma en styrning resp. styrindikering av en 
markberedningsmaskin, som ger mojlighet till flillgod styrning av maskinen med si 
5 fa utanfor maskinen placerade matenheter som mojligt. 

En annat syfte med uppfinningen ar att astadkomma en styrning av en markbered- 
ningsmaskin, dar det ar indikeringen av arbetslage och arbetsriktning av den 
bearbetande delen av maskinens arbetsverktyg som ar det vasentliga, men dar 
4) 10 inverkan av den bearbetande delens skakningar, ogynnsamma milj6, skymda lagen 
etc undanrojs. 

Ytterligare ett syfte med uppfinningen ar att astadkomma en direkt positionsbe- 
stamning och automatisk foljning av den bearbetande delen av maskinens bearbetan- 
15 de del under arbetsoperationen. 

Annu ett syfte med uppfinningen ar att astadkomma stor flexibilitet i uppstallning av 
ett matsystem i forhallande till arbetsmaskinen i kombination med stort arbetsomra- 
de f hog noggrannhet och fjarr- och/eller narindikerbar positionering. 

Annu ett syfte med uppfinningen ar att astadkomma ett flexibelt system, som ar 
" - " - " anvandbart fbr uppmatning av det momentana arbetslaget och arbetsriktningen for 

. olika typer av arbetsmaskiner, t.ex. markberedningsmaskiner, gravmaskiner, 
. " ; • lyftkranar m. fl. 

: ,* : 25 

Annu ett syfte ar att astadkomma en momentan, kontinuerlig och korrekt lages- och 
: . . . - riktningsindikering av en markberedningsmaskin under arbete t.o.m. under snabba 

: " rOrelsefbrlopp. 
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S AMMANFATTNING AV UPPFINNTNGEN 

5 Ovan angivna syften uppnas med en anordning, som erhallit de i den kannetecknan- 

de delen av patentkravet 1 angivna sardragen. Ytterligare egenskaper och vidareut- 
vecklingar samt ett forfarandet anges i de ovriga patentkraven. 

Teknikomradet for uppfinningen hanfor sig till en anordning och ett forfarande for 
10 art bestamma laget for en bearbetande del av ett verktyg pa en arbetsmaskin i ett fast 
markbundet koordinatsystem. For art astadkomma detta utan art placera utrustning 
pa den bearbetande delen behover positionen hos en punkt pa maskinen (x,y,z), samt 
maskinens lutning (f x och f y i forhallande till lod) och dess orientering kring en 
vertikal axel (4) i detta fasta koordinatsystem bestammas. Dessutom maste den 
1 5 bearbetande delens position i forhallande till den inmatta punktens position i ett 
lokait maskinbundet koordinatsystem vara kand. Antingen ar denna placer ing fast 
och kand, eller ocksa kan olika metoder anvandas for att bestamma lagesrelationen 
som t ex bygger pa givare av te x potentiometer- eller resolvertyp som placeras vid 
lankarna som kopplar verktyget till maskinen. Sadana metoder ar tidigare kan da och 
2 0 behandlas ej i detta sammanhang. 

- Uppfinningen omfattar ett system med en lagesbestammande apparatur innefattande 

. : _ minst en detektorutrustning placerad pa ett agnat stalle pa arbetsmaskinen for att 

. - : ^ bestamma detta stalles position i ett fast koordinatsystem, minst en lagesrelationsan- 

; . ; . 2 5 ordning for att bestamma maskinens lutning och/eller orientering (lutning och 

orientering sammanfattas i fortsattningen under benainningen orientering) i samma 
fasta koordinatsystem samt med en en accelerometeranordning. Den bearbetande 
delens lagesrelation i forhallande till detektorutrustningen i ett maskinbundet 
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koordinatsystem forutsatts kand. Dessutom ingar en berakningsanordning som med 
signaler fran den positionsbestammande apparaturen och lagesrelationsanordningar- 
na beraknar den bearbetande delens lage i det fasta koordinatsystemet. Uppfinningen 
kannetecknas ocksa av art den lagesbestammande apparaturen innefattar en oriente- 
ringsmatande anordning sa att apparaturen mater momentant saval position som 
orientering av namnda stalle hos arbetsmaskinen i det fasta koordinatsystemet, och 
att berakningsanordningen omraknar matresultatet fran den lagesbestammande 
apparaturen och lagesrelationsanordningarna till att ge den bearbetande delens 
momentana saval position som orientering i det fasta koordinatsystemet. 

Den positions- och orienteringsbestammande apparaturen kan innefatta dels en 
relativt sett langsam, noggrann bestamninganordning, som med tidsintervall 
noggrant mater det aktuella laget och orienteringen hos maskinen, och dels en snabb 
bestamninganordning, som reagerar pa positions- och/eller orienteringsandringar for 
att berakna och uppdatera bestamningen mellan de namnda tidsintervallen. Derma 
snabba bestamningsanordning behover da endast vara korttidsstabil eftersom en 
langsam drift korrigeras genom uppdatering fran den lingsammare anordningen. 

Den relativt langsamma, noggranna positions- och orienteringsbestamningen kan ske 
^ 20 med hjalp av en stationar matstation, t.ex. ett geodetiskt instrument med automatisk 

malinriktning eller en radionavigeringsantenn, t.ex. for GPS (Global Positioning 
: V: System), placerad i narheten av arbetsmaskinen for lagesbestamning i samverkan 

: med detektoranordningen. Lutningarna kan ocksa bestammas med t ex inklinometrar 

■ : och orienteringen kring vertikalaxeln t ex med kompass eller med ett nordsCkande 

|:.V25 gyro. 

: : Den korttidsstabila bestamningsanordningen kan darvid innefatta en acceleromete- 

: - - ranordning hos maskinen f5r matning av accelerationen hos maskinen i minst en 
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riktning, foretradesvis i flera inbordes olika riktningar, varvid berakningsenheten 
dubbelintegrerar den eller de indikerade accelerationerna och uppdaterar senaste 
berakningsresultatet av positionen i det fasta koordinatsystemet. 

5 Vid behov av en snabb bestamning av en orienteringsandring utnyttjas foretradesvis 
ytterligare en accelerometer eller ett gyro for varje axel kring vilken vridning skall 
bestammas. Signalerna fran dessa givare anvands efter lamplig integrering samt 
omvandling fran maskinens koordinatsystem till ett fast koordinatsystem, till att 
uppdatera lagesbestamningar for maskinen i det fasta koordinatsystemet. Ett lampligt 
10 satt att sammanvaga informationen fran de langsammare och de snabba givama pa 
ett optimalt satt ar att anvanda sig av Kalmann-filtrering. 



Foretradesvis gors matning och berakning i interval ler standigt under det att maski- 
nen ar i verksamhet. Berakningsenheten beraknar efter varje matning position, samt 
1 5 eventuellt arbetsriktning och arbetshastighet hos den bearbetande delen av verktyget 
under anvandande av senaste och tidigare berakningsresultaten for lage. Beraknings- 
enheten kan aven utnyttja tidigare berakningsresultat for att forutsaga trolig place- 
ring, orientering, arbetsriktning och hastighet en viss tid i forvag for arbetsmaskinens 
bearbetande del. 




FORDELAR MED UPPFINNINGEN 

: Med uppfinningen har man skapat ett matsystem, som ar enkelt att anvanda och som 

- dessutom ar relativt billigt. Redan befintliga stationer for inmatning av ett omrade 

.; .25 kan utnyttjas for att styra arbetsmaskinerna. Detta innebar att specialutrustning for 

.:. stationerna inte behover kopas in eller forslas till arbetsplatsen speciellt fbr att 

: ' " " : anvandas vid uppfinningen. 
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Genom att det ar sjalva arbetsmaskinens position och orientering, som mats, och den 
bearbetande delens lage darefter beraknas med hjalp av signaler fran liigesrela- 
tionsanordningarna, erhalls ett system, som kan utnyttja separata styr- och sensorsys- 
tem av vilket slag som heist for maskinen, speciellt betraffande beredningsmaskiner 
5 och gravmaskiner. Kansliga vridindikatorer pa sjalva den skakande bearbetande 
delen kan undvikas. 

KORT FIGURBESKRIVNING 

^) 10 Uppfinningen beskrivs narmare nedan under hanvisning till de bifogade ritningama, 
dar 

visar schematiskt en gravmaskin med en forsta utforingsform av ett 
matsystem eniigt uppfinningen, 

visar ett blockschema pa en accelerometeranordning, 

visar en andra utforingsform av ett system eniigt uppfinningen 

visar en utforingsform av en reflektorplacering pa gravmaskinen i fig. 3, 

visar en utforingsform av en detektorenhet anvand vid matsystemet 
eniigt uppfinningen, 

visar ett forsta utforande av en detektor for anordningen i fig. 5 A, 
visar ett andra utforande av en detektor for anordningen i fig. 5 A, 



FIG. 1 



15 



FIG. 2 



FIG. 3 



20 FIG. 4 



FIG. 5A 



25 FIG. 5B 



FIG. 5C 
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FIG. 6 visar schematiskt en gravmaskin med en tredje utforingsform av ett 
matsystem enligt uppfinningen. 

FIG. 7 visar ett blockschema for ett helt matsystem enligt uppfinningen. 

FIG. 8 visar en bild pa en bildskarm i gravmaskinens styrhytt 



DETALJERAD BESKRIVNING AV OLIKA UTFORINGS FORMER AV 
UPPFINNINGEN 

Utforingsform 1 

Enligt den i figur 1 visade utforingsformen ar ett geodetiskt instrument 1 uppstallt pa 
ett markomrade, som skall bearbetas. Instrumentet 1 ar t.ex. ett elektroniskt distans- 
matinstrument 2 med integrerad avstands- och vinkelmatning av den typ, som kallas 
totalstation och som marknadsfors av SPECTRA PRECISION AB, dvs med 
kombinerad avancerad elektronik och datateknik. Instrumentets 1 position och 
horisontalvinkellage mats forst upp pa gangse satt valkant for fackmannen. Detta kan 
exempelvis gSras genom matningar mot punkter i omradet med fdrbestamda 
positioner, t.ex. kyrktorn e.d. 

Ett geodetiskt instrument ger bade avstand och vertikal- och horisontalriktning mot 
ett mal, varvid avstandet mats mot en reflektor, t.ex. av kubhornstyp. Ett geodetiskt 
instrument ar dessutom forsett med en dator med inskrivbara data for matningar som 
skall utfbras och lagring av under matningar erhallna data. Foretradesvis anvands for 
uppfinningen ett obemannat geodetiskt instrument, vilket innebar art instrumentet 
automatiskt soker efter och staller in sig mot och fbljer ett avsett mil. Detta kan 
utgoras av samma reflektor som anvands for avstandsmatningen eller nagot annat 
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aktivt mal som beskrivs senare. Det geodetiska instrumentet beraknar positionen for 
ett mal i ett fast markbaserat koordinatsystem. 

En arbetsmaskin i form av en markberedningsmaskin 3, t.ex. en markskrapmaskin, 
ar for den langsammare, noggranna positionsmatningen i denna utforingsform 
forsedd med en reflektorenhet 4 t ex ett kubhornsprisma i en placering pa maskinen, 
som ar val synlig fran det geodetiska instrumentet 1, hur an maskinen vrider och 
vander sig, pa maskinens tak i detta fall, samt med en orienteringsbestarnmande 
enhet 5a, 5b och en anordning 6 innefattande minst en accelerometer for accelera- 
tionsavkanning och eventueilt ytteriigare en accelerometer eller en gyroenhet for 
rotations a vkanning. 

Ett kubhornsprisma reflekterar tillbaka en infallande strale i motsatt riktning, aven 
om infallsriktningen mot det ar relativt sned. Det ar vasentligt att reflektorenhet 4 
inte vander en icke reflekterande sida mot instrumentet 1 . Den bor darfor foretra- 
desvis best a av en uppsattning kubhornsprismor placerade i ring omkring en axel. 

Maskinens orientering i ett fast koordinatsystem i denna utforingsform bestams av 
enheten 5a, 5b som t ex innehaller tva lutningsgivare 5a for att bestamma lutningen 
mot en lodaxel i tva vinkelrata riktningar samt en eiektronisk kompass eller ett 
nordsokande gyro 5b for att bestamma orienteringen i ett fast koordinatsystem t ex i 
f&rhallande till nord. 

Det ar vasentligt att systemet kan folja snabba foriopp, eflersom maskinen under sitt 
arbeta kan vicka till genom att den kor pa en sten eller ner i en grop. En mOjlighet till 
en korttidsstabilt noggrann och snabb bestamning av positions- och orienteringsand- 
ringar i det maskinbundna koordinatsystemet, for efterffcljande omvandling till det 
fasta koordinatsystemet, bor darfor finnas. Med en sadan mojlighet kan positions- 
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och riktningsandringar bestammas i intervallet meilan de langsammare positions- 
och orienteringsbestamningen av maskinen via totalstationen. 

Darfor ar accelerometeranordningen 6 placerad pa maskinen for indikering av 
snabba rorelser. Denna anordning 6 bor fdretradesvis avkanna snabba rorelser och 
rotation hos maskinen i olika riktningar, for art ge en fiillgod runktion. Ett minimi- 
krav ar dock att anordningen avkanner acceleration utmed en axel hos maskinen, och 
da fdretradesvis dess normait vertikala axel (z-axeln), eftersom noggrannhetskraven 
normalt ar hardast i denna riktning, da avsikten med markberedningen normait ar att 
astadkomma en viss bearbetningsniva i vertikalled. Fdretradesvis b6r dock anord- 
ningen 6 avkanna acceleration och/eller rotation i fdrhallande till tre olika axlar hos 
maskinen. 

Accelerationsmatarna kan vara av vilken konventionell typ som heist och beskrivs 
och exemplifieras icke narmare, eftersom de icke utgdr nagon del av den egentliga 
uppfmningen. Deras utsignaler dubbelintegreras med avseende pa tiden, for att ge en 
positionsandring. Detta kan ske i enheten 6 eller i en datorenhet 20 (se fig 8). De 
beraknde positionsfdrandringarna ges i maskinens koordinatsystem men omraknas 
sedan till det fasta koordinatsystemet, sa att maskinens rorelser i det fasta koordinat- 
systemet hela tiden blir det som Idpande indikeras. Dessa indikeringar sker med sa 
korta intervall som ar lampade for det anvanda styrsystemet. 

Det geodetiska instrumentet 1 kan ge absolutbestamningar av reflektorenhetens 
position i det fasta koordinatsystemet med ett tidsintervall pa ca 0.2 - 1 sek, varvid 
data fran anordningen 6 ger stottning av matsystemet daremellan. 

Den markbearbetande delen 7, dvs skrapdelen pa maskinens 3 skrapblad 8, ar det, 
som egentligen skall indikeras i det fasta koordinatsystemet till lage, vridning i 
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horisontell och vertikal riktning samt heist aven betraffande sin rorelseriktning och 
rorelsehastighet. 

Maskinens egen lagesrelationsgivare (ej visad) ger underlag for berakning av skrap- 
delens 7 momentana position i maskinens koordinatsystem. Avkanning och berak- 
ning av skrapbladets momentana installing i fdrhallande till maskinen med geome- 
triska berakningar ar valkand teknik och behover darfor icke beskrivas narmare. 
Kombinationen av information fran de olika sensorerna till en slutlig position och 
orientering i det fasta koordinatsystemet sker lampligen i huvuddatorn 20. En 
lamplig metod art erhalla en optimal kombination av informationen fran de olika 
sensorerna for bestamning av aktuell position och orientering ar anvandande av 
Kalmann-filtrering. 

Figur 2 visar schematiskt en accelerometeranordning 6 for avkanning utmed en axei 
hos maskinen och med rotationsavkanning kring en vinkelrat axel. Darvid avkannes 
accelerationerna a, och a 2 med accelerometer ACC loch ACC 2. Genom kombina- 
tion av dessa tva matvarden och med kannedom om avstandet d mellan acceleromet- 
rarna kan vridning och acceleration hos nagon vald punkt (A) beraknas. Genom tre 
likadana uppsattningar kan givetvis acceleration langs och vridning kring tre axlar 
bestammas. Som alternativ eller komplettering kan rotationsandringarna kring en 
eller flera axlar bestammas m h a gyron. 

Utforingsform 2 

Markberedningsmaskinen 3 i figur 3, ar for den langsammare, noggranna oriente- 
ringsbestamningen kring vertikalaxeln i derma utforingsform fbrsedd med tva 
reflektorenheter 4a och 4b i en placering pa maskinen, som ar val synlig fran det 
geodetiska instrumentet 1. 1 utforingsformen enligt fig. 3 ar de placerade med en i 
huvudsak fast placering i forhallande till varandra och maskinen. Mojligheten att ha 
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reflektorerna flyttbara mellan olika "fasta" positioner for art fa en iamplig oriente- 
ring i forhallande till matinstrumentet ar uppenbar. Var och en av dem bor fbretra- 
desvis besta. av en uppsattning kubhornsprismor placerade i ring omkring en axel. 

Maskinens tredimensioneila placering och orientering i ett fast, eller i forhallande till 
matinstrumentet definierat, koordinatsystem uppmats genom matningen mot 
reflektorenheterna 4a och 4b, vilka har en bestamd eller bestambar placering i 
maskinens koordinatsystem. Genom bestamning av reflektorenas positioner i det 
fasta koordinaatsystemet kan da maskinens orientering i detta koordinatsystem 
bestammas, vilket innebar art trans formationen mellan koordinatsystemen blir 
definierad. 

Reflektorenheterna 4a och 4b i figur 3 har var sin inriktningsindikator 12 och 13, 
som ger riktningsanvisning for det geodetiska instrumentet betraffande det mil eller 
den reflektor, mot vilken dess momentana inriktning skall goras i och for matning 
mot detta mal. Riktningsindikatom kan vara av olika typer bara den riktar in det 
geodetiska instrumentet automatiskt mot den matreflektor, som for Sgonbiicket skall 
tjana som mal for matningen. 

Riktningsindikatorerna ar dock i den i figur 3 visade utfbringsformen lyselement, 
foretradesvis med en spec i ell modulation och vaglangdskaraktar sarskiljbar fran 
omgivningsljuset, och visas har placerade under sin respective malreflektor och 
foretradesvis sa art deras ljus syns fran alia hall. Det geodetiska instrumentet 1 ar 
harvid lampligen under sjalva avstandsmataren 2 forsett med en sokar- och install- 
ningsenhet 14, som sOker mot en ljussignal, och darvid med samma modulation och 
vaglangdskaraktar som lyselementen. Var och en av inriktningsindikatoma 12 och 
1 3 kan lampligen besta av flera lyselement arrangerade i en ring pa samma satt som 
reflektorerna for att tacka en stor horisontalvinkel. 
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Lyselementen i 12 och 13 tands omvaxlande med varandra i sadan takt att sokar- 
och installningsenheten 14 hinner stalla in sin inriktning mot det lysande av lysele- 
menten, och matning av avstand och inriktning mot dess tillhorande rnal hinner 
goras. Matning utfors i sekvens mot de bada reflektorenheterna 4a och 4b. 

Alternativt kan tre (eller flera) reflektorenheter med lyselement vara placerade pa 
forbestamda platser pa maskinen, varvid matning mot dessa mal med berakningar 
ger position, inriktning och orientering av maskinen i ett tredimensionellt fast 
koordinatsystem. 

Figur 4 visar en annan utfbringsform av en malenhet 30, mot vilken det geodetiska 
instrumentet 1 kan mata for att fa lagesdata for maskinen 3. Malenheten innefattar i 
detta fall en skiva 31, som roterar omkring en mot skivan normal axel 32. Ett mil, 
har i form av en reflektor 33, t.ex. en ring av reflektorer av kubhornstyp, ar monterad 
nara skivans 3 1 periferi. Det vasentliga med denna utfbringsform ar att reflektom 33 
roterar omkring en axel 32, varfor den istallet kan vara monterad pa en roterande 
arm (icke visat). Den som reflektor utformade detektorenheten 33 ar saledes flyttbar 
mellan positioner med bestambara lagen i fbrhallande till arbetsmaskinen och en 
indikeringsenhet t ex en encoder (icke visad) indikerar kontinuerligt laget. 

Ett ytterligare alternativt satt for bestamning av maskinens orientering ar att anvanda 
en servostyrd optikenhet som automatiskt inriktar sig mot det geodetiska instrumen- 
tet. Med t ex en encoder kan optikenhetens inriktning avlasas i maskinens koordinat- 
system. En utfbringsform av detta visas i figur 5A - 5C. Minst en servostyrd 
optikenhet 26-29 inriktar sig mot det geodetiska instrumentet. I detta fall ar optiken- 
heten sammanbyggd med reflektorn, vilket ger fbrdelen att denna kan besta av ett 
enkelt prisma och ej en prismaring. Dock kan enheterna ocksa vara separerade. For 
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optikenheten ar det lampligt att utnyttja det geodetiska instrumentets matstrale eller 
en med denna parallell strale. 

I den i figur 5 A visade utforingsformen ar optikenheten 26 placerad bredvid den i 
snitt visade reflektorn 25. Optikenheten bestir av en lins eller linssystem 27 och en 
positionskanslig detektor 28. Linsen/linssystemet fokuserar matstralen pa detektorn 

28, som t.ex. ar en kvadrantdetektor, sasom visas i figur 5B. Det geodetiska instru- 
mentets 1 matstrale kan harvid anvandas aven for inriktningsanordningen om stralen 
ar tillrackligt bred. Alternativt och ur teknisk synpunkt foretradesvis ar dock 
instrumentet fbrsett med en extra ljuskalla, t.ex. laser, som mot enheten 26-28 
sander en smal ljusstrale, som da kan ha helt annan karaktar, t.ex. annan viglangd, 
an den mot reflektorn 25 sanda matstralen, och ar parallell med och anordnad med 
samma avstand fran matstrilen som rorets 26 centerlinje fran reflektorns 25 center- 
linje. 

Ett tredje alternativ ar att placera en kubhSrnsprisma tor inriktning pa referenssta- 
tionen (icke visat) och en ljuskalla 23 (streckat ritad) intill optikenheten (26-28). Da 
fas en fran prismat reflekterad strale som fokuseras pa kvadrantdetektorn da opti- 
kenheten ar ratt inriktad mot stationen. 

Vid anvandning av en kvadrantdetektor 28 kan servostyrningen ske sa, att deldetek- 
torerna far si likartad belysning som mqjligt. Dylika detektorer ar i och for sig 
valkanda, liksom deras anvandning vid olika typer av servostyrningsarrangemang 

29, och beskrivs darfbr icke narmare. 

Optikenheten ar rOrligt och styrbart monterad pa maskinen och eventuellt integrerad 
med reflektorn. Genom servostyrningen av servomotorer (icke visade) inriktas 
optikenheten si, att signal erna fran detektorn 28 balanseras, vilket innebar att 
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enheten ar orienterad i matstralens riktning. Inriktning i forhallande till arbetsmaski- 
nen kan avlasas t.ex. med nagon typ av enkoder, eller med annan typ av avkanning 
av de styrda servomotorernas momentana installningslagen. 

Ovanstaende inriktning kan ske i bade horisonteli och vertikal led, men komplexite- 
ten reduceras avsevart om man begransar sig till styrning i horisontalled. Detta ar 
ofta tillrackligt da maskinens lutning normalt ar mattlig i forhallande till normalpla- 
net. I ett sadant fall kan detekteringen goras med hjalp av en i sidled langstrackt 
detektor och en cylinderlins som samlar stralningen inom ett visst vertikalvinkelom- 
rade mot detektorn. Eflersom figur 5 A visar en tvarsektion stammer den aven vid 
denna utforingsform. Detektorn kan utgoras av t ex en endimensionell rad av 
element av t ex CCD-typ, sasom visas i figur 5C. 

Kannedom om riktningen fran det geodetiska instrumentet till lagesdetektorn, vilket 
ges av det geodetiska instrumentet, tillsammans med enkoderavlasningen, som ger 
maskinens orientering i forhallande till det geodetiska instrumentet, ger saledes 
maskinens orientering i ett fast koordinatsystem. 

Servostyrningen av malreflektorn gor art man standigt far information om fordonets 
inriktning i forhallande till det geodetiska instrumentet 1. 

Utfbringsform 3 

I de ovan beskrivna utforingsformerna har positionsmatning skett genom matning 
mot ett eller flera mil pa matforemalet fran en geodetiskt instrument 1. Positions- 
matning kan aven ske med hjalp av radionavigation, t.ex. GPS (Global Position 
System), genom art placera en eller flera radionavigationsantenner pa matforemalet 
och en pa en stationar station vid sidan av. 
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I den i figur 6 visade utforingsformen sitter en radionavigationsantenn 50, som har 
visas mottaga signaler frin ett antal GPS-satelliter 49, vid periferien pi en roterande 
skiva 51 pa den ovre delen av en gravmaskin 52. Antennpositionen indikeras i en 
radionavigations-mottagare 55 i minst tvi forbestamda rotationslagen hos skivan 51 
relation till gravmaskinen 52. Skivan roterar si lingsamt att antennpositionen i varje 
rotationslage kan indikeras med noggrannhet men anda si snabbt, att normala 
rorelser hos gravmaskinen inte inverkar menligt pa matresultatet. 

En referensstation 1 ' med en annan radionavigationsantenn 53 med mottagare 54 ar 
monterad pi en station, som ar placerad pa ett forbestarnt staile i naturen med kand 
position nagot vid sidan av den mark, som skall bearbetas. En differentiell positions- 
bestamning erhills genom radiooverfbring mellan radionavigationsmottagaren 54 
och berakningsebheten 20 i maskinen 52. Man beraknar maskinens momentana 
position med s.k. RTK-matning (Real Time Kinematic). En berakning av detta slag 
ar i och for sig valkand och behover inte beskrivas narmare. 

Den enda skillnaden mot tidigare utforingsformer ar att positionsbestamningen mot 
milet/milen g&rs med GPS-teknik i stallet for genom matning med totalstation. I 
ovrigt kan orienteringsbestamning och bestarnning av snabba fbrflyttningar och 
vridningar ske pi samma satt som beskrivits i tidigare utforingsformer. 

Gemensamt blockschema 

Figur 7 visar ett blockschema enligt uppfinningen som ar tillampligt pi samtliga 
utforingsformer. Det kan pipekas art, vid positionsbestamning med ett geodetiskt 
instrument, positionsdata fbr milet samlas in i referensstationen 1 och overfors till 
maskinen via radiolank, medan i GPS-fallet det ar korrektionsdata frin mottagaren 
54 som overfors frin referensstationen 1 * till maskinen och att positionsdata 
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framraknas i berakningsenheten 20 med utgangspunkt fran data fran mottagarna 54 
och 55. 

Berakningsenheten 20 beraknar saledes genorn sammanstallning av data fran 
referensstationen 1 och i GPS-fallet mottagaren 55 tiilsammans med data fran 
orienteringssensorer 5, accelerometeranordning 6 och givare for relativ position 1 1, 
skrapbladets momentana Iage i det fasta koordinatsystemet, dvs omvandlat fran 
maskinens koordinatsystem. Givarna for relativ position 1 1 kan t ex utgoras av 
encodrar eller potentiometergivare kopplade till lankarna som forbinder den bearbe- 
tande delen med maskinen. Berakningsenheten 20 ar foretradesvis placerad i 
maskinen. 

Den onskade markberedningen i det fasta koordinatsystemet ar inprogrammerad 
antingen i det geodetiska instrumentets 1 eller foretradesvis maskinens 3 dator 20. 
Derma ar forsedd med en presentationsenhet 9, foretradesvis en bildskarm, som for 
maskinskotaren (icke visad) presenterar dels hur maskinen 3 och dess skrapblad 8 
skall manovreras utifran det momentant befintliga laget och dels dess momentana 
awikelse fran onskad manovrering. Alternativt och foretradesvis sker en automatisk 
styrning av bearbetningsdelen till avsedd hojd och orientering med hjalp av 
styrutrustningen 12 bestaende av t ex hydrauliska manoverorgan som styrs fran 
enheten 20. 

Maskinskotaren maste ibland gora awikelser fran narmast till hands Iiggande 
arbetsmonster pi grund av hinder av olika slag, sasom stenar e.d., som inte finns 
medtagna t den i det geodetiska instrumentet inprogrammerade kartbiiden pa Onskad 
struktur hos markberedningsornridet. 
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Det ar aven mojligt att for maskinskdtaren pa bildskarmen 9 visa en inprogrammerad 
kartbild pa onskad beredning och skrapdelens 7 befintliga lage och rdrelseriktning i 
kartbilden. Information mellan det geodetiska instruments 1 och maskinen 3 kan 
skickas tradldst i bada riktningar, sasom antyds med den zickzackade forbindelsen 
10. Datorn i den ena eller den andra av dessa enheter kan valjas att utgora den 
huvuddator, som utfor de vasentliga berakningarna anvandbara for maskinens 3 
arbete med skrapbladet, men foretradesvis gors detta i enheten 20. Det vasentliga har 
ar att berakning av skrapbladets position och orientering gors i det fasta koordinat- 
systemet, oavsett var, att det geodetiska instrumentet och elektroniska enheter i 
maskinen har dataoverforande forbindelse med varandra, och att maskinskotaren far 
en lattfattlig presentation av vad som skall goras och vad som ar fardigt. 

Figur 8 visar ett exempel pa en bild, som kan presenters for maskinskdtaren pa 
presentationsenheten 9. Har overlagras en bild av skrapbladet med en inriktnings- 
markering pi en kartbild med onskad profil over markberedningsomradet, varvid 
bilden av skrapbladet ju fbrflyttar sig over kartbilden under arbetets gang. Presenta^ 
tionsenheten 9 kan vara delad och aven visa en profilbild med skrapbladet placerat 
vertikalt over eller under onskad markniva och med angivande av hojdskillnad 
gentemot denna. 

Den verkliga marknivan behdver inte visas. Dock kan det vara lampligt att visa 
markpartier med den dnskade hojden tydligt i bilden for maskinskotaren, sa att nan 
vet var han skall satta in sitt arbete. Det ar da mojligt att ha en funktion, som ger 
markpartier med en liten skillnad inom en fdrbestamd toleransniva mellan verklig 
och onskad niva en forbestamd farg, t.ex. gron. 

Det ar aven mojligt att, tex. sasom visas streckat i kartbilden, visa en skuggbild av 
skrapbladet for att indikera att det annu inte befinner sig pa ratt niva. Det ser darvid 
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ut som om skrapbladet svavar over marken, och maskinskotaren far en askadlig 
indikering av hur djupt maskinen maste skrapa for att fa skuggbilden att fdras ihop 
med bilden av skrapbladet. Del ar vid uppfinningen lampligt att det ar de onskade 
nivaema for markberedningen som visas pa kartbilden, varfor det ar skuggbildens 
lage som indikerar var skrapbladet 7 befinner sig normalt mot kartans plan. Kartbil- 
den over den verkliga markstrukturen ar ointressant att visa i detta sammanhang. 

Berakning av position och vridning av maskinen bade i vertikal och horisontell 
riktning gors i det fasta koordinatsystemet, samt efterfdljande berakning av skrap- 
bladets momentana position och vridningsvinklar efter omvandling fran maskinens 
koordinatsystem till det fasta koordinatsystemet. Darefter foljer en ny sekvens med 
samma matningar och berakningar med efterfQljande berakning av skrapbladets 
fbrflyttning fran fdrra matningen, varigenom bladets riktning och hastighet erhalls 
och presenteras pa presentations-enheten 9. 

Dessa matsekvenser upprepas under maskinens skraparbete, varigenom maskinsko- 
taren hela tiden under arbetets gang far momentana data betraffande skrapbladets 
lage, inriktning, fdrflyttningsriktning och hastighet i det fasta koordinatsystemet och 
saledes far en mycket god uppfattning om hur arbetet fortloper gentemot den 
onskade markberedningen, och hur maskinen skall manovreras. 

Det geodetiska instrumentet kan endast utfdra sina installningar och matningar i en 
relativt lingsam takt i det fasta koordinatsystemet. Accelerometeranordningen 
utnynjas for att uppdatera matresultaten i mellantidema. En speciell fdrdel med 
denna uppdateringsfunktion mellan uppgraderingama med det geodetiska instrumen- 
tet ar att, eftersom matning mot de bada matmaJen 4a och 4b i fig. 3 ju inte kan 
genomfdras samtidigt, det ar mojligt att med uppdateringen astadkomma, att 
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fordrojningen mellan de sekventieila matningarna mot reflektorerna biir kompense- 
rad. 



Genom att maskinens forflyttningsriktning och hastighet beraknas Iopande ar det 
aven lampligt att av tidigare berakningsdata framrakna en fdrutsagbar placering och 
orientering for bade maskin och bearbetande del en viss tid i forvag. Hur sadana 
berakningar utfors med hjalp av de senaste och tidigare beraknade data ar uppenbart 
for fackmannen och beskrivs darfbr icke narmare. 

Manga modifleringar av de visade utforingsformema ar mbjliga inom den ram, som 
ges av de bifogade patentkraven. Det ar saledes mojligt att ha blandformer med bade 
prismor och radionavigations-antenner som lagesdetektor-enheter. T.ex. kan en 
geodetiskt instrument lages- och rotationsiririktriingsbestammas med hjalp av en 
eller fler radionavigations-antenner, t.ex. en pa det geodetiska instrumentet och en ett 
stycke pa avstand fran den. Andra typer av arbetsmaskiner an de visade, dar man vill 
ha Iopande information om position, vinkellagen och arbetsriktning under arbetets 
gang, som t.ex. lyftkranar, mudderverk e.d, lampar sig utmarkt att fSrses med 
uppfmningen. Varje angiven berakningsenhet ar iampligen en dator eller ett delpro- 
gram i en dator, sasom ar brukligt nufortiden. 
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PATENTKRAV 

1 . Anordning for att bestamma iaget for en bearbetande del av ett verktyg pa en 
arbetsmaskin med en lagesbestammande apparatur (1, 4, 5a, 5b, 6; 1, 4a, 4b, 5a, 5b, 
6; 31, 33; 49, 50, 51, 1\ 53) innefattande minst en detektorutrustning ( 4, 5a, 5b, 6; 
4a, 4b, 5a, 5b, 6; 3 1, 49, 50, 5 1, 53) placerad pa ett agnat stalle pa arbetsmaskinen 
(3; 52) for att bestamma detta stalles position i ett fast koordinatsystem, samt med 
minst en lagesrelationsanordning (1 1) for att bestamma den bearbetande delens 
lagesrelation i fdrhallande till detektorutrustningen i ett maskinbundet koordinatsys- 
tem, samt en berakningsanordning (20) som med signaler fran den positionsbestam- 
mande apparaturen och lagesrelationsanordningen beraknar den bearbetande delens 
lage i det fasta koordinatsystemet, 
kannetecknad av att 

den lagesbestammande apparaturen innefattar en lutnings- och orienteringsmatande 
anordning (5a, 5b, 20; 4a, 4b, 20; 31, 20; 51, 20) si att apparaturen mater momentant 
saval position som orientering av namnda stalle hos arbetsmaskinen i det fasta 
koordinatsystemet, och att berakningsanordningen (20) omraknar matresultatet fran 
den lagesbestammande apparaturen och lagesrelationsanordningen till att ge den 
bearbetande delens momentana position och/eiler orientering i det fasta koordinat- 
systemet. 

2. Anordning enligt krav 1, kannetecknad av att den lagesbestammande apparaturen 
innefattar minst en detektorenhet (4) placerad fast pa arbetsmaskinen och en 
norrsOkande enhet (5b), sasom ett norrsokande gyro eller en elektroniskt avkannbar 
kompass, for momentan avkanning av arbetsmaskinens inriktning i fbrhillande till 
norr. 
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3. Anordning dar den lagesbestammande apparaturen innefattar en stationar matsta- 
tion (1;T) placerad i narheten av arbetsmaskinen for lagesbestamning i samverkan 
med detektoranordningen, enligt krav 1, kannetecknad av an den positions- och 
orienteringsbestammande apparaturen innefattar antingen minst tva detektorenheter 

5 (4a, 4b) anordnade i fasta positioner relativt arbetsmaskinen, vilka i samverkan med 
den stationara stationen ger positioner fast i rummet for sina placeringar och vilkas 
inbordes uppmatta positioner ger orienteringen i rummet for den del av arbetsmaski- 
nen dar de ar placerade, eller minst en rorlig detektorenhet (33;50) flyttbar melian 
positioner med bestambara lagen i fbrhallande till arbetsmaskinen. 

#10 

4. Anordning enligt krav 3, kannetecknad av att lagesdetektorenheten (33;50) ar 
vridbar omkring en pa avstand fran den placerad axel (32) i fbrhallande till arbets- 
maskinen, varvid matning mot lagesdetektorenheten indikeras nar den intar bestam- 
bara vinkellagen runt axeln i forhallande till arbetsmaskinen. 

15 

5. Anordning enligt krav 1, kannetecknad av minst en pa arbetsmaskinen placerad 
rorligt monterad och styrbar optikenhet (26-28,23), som inriktar sig mot den 
stationara matstationen med hjalp av antingen den stationara stationens matstrale 
eiier en med derma parallell strale eller en strale utsand fran optikenheten och 

2 0 reflekterad i ett prisma hos den stationara stationen, varvid optikenhetens orientering 
i forhillande till arbetsmaskinen indikeras och overfors till berakningsenheten (20) 
for bestarnning av arbetsmaskinens orientering i det fasta koordinatsystemet. 

. : ; 6. Anordning enligt nagot av fbregaende krav, kannetecknad av att varje lagesde- 

25 tektorenhet ar minst en radionavigations-antenn (50, 53) med mottagare. 

- 7. Anordning enligt nagot av kraven 1 - 5, kannetecknad av att den lagesbestam- 

... mande apparaturen innefattar ett geodetiskt instrument ( 1 ; T ) med malsokningsfunk- 
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tion placerat pa avstand frin arbetsmaskinen (3) och matande mot minst ett mil, t.ex. 
en reflektor, pa arbetsmaskinen. 



en 



8. Anordning enligt krav 7, kannetecknad av att varje mal (4a,4b) ar forsett med 
inriktningsindikator (12,13), som ger riktningsanvisning for det geodetiska instru- 
ments betraffande det mal, mot vilket dess momentana malsokning skall goras i och 
for matning mot detta mal. 

9. Anordning enligt nagot av foregiende krav, kannetecknad av att berakningsan- 
ordningen (20) ar fdrsedd med en inlagrad kartbild med onskad topografi over ett 
omrade, som skall bearbetas, och beraknade data for den bearbetande delen presente- 
ras till lage och vinkellagen relativt kartbilden pa en presentationsenhet (9)(fig. 8). 

10. Anordning enligt nagot av foregaende krav, kannetecknad av att den positions- 
och orienteringsbestammande apparaturen innefattar dels en relativt langsam, 
noggrann bestamninganordning (1,4; l,4a,4b;53,50,51), som med tidsintervall 
noggrant mater det aktuella laget och orienteringen hos maskinen, och dels en 
relativt snabb bestamninganordning 

ACC; ACC1,ACC 2; 6), som reagerarpa positions- och/eller orienteringsskillnad 
mot tidigare bestamning eller bestamningar for att berakna och uppdatera bestam- 
ningen mellan de namnda tidsintervallen. 

1 1. Anordning enligt krav 10, kannetecknad av att den relativt snabba bestamnings- 
anordningen innefattar minst en accelerometeranordning (6; ACC 1; ACC 1, ACC 2) 
hos maskinen for matning av accelerationen hos maskinen i minst en riktning, 
foretradesvis i flera inbordes olika riktningar, varvid berakningsenheten (20) 
integrerar den eller de indikerade accelerationerna och uppdaterar senaste berak- 
ningsresultatet av positionen i det fasta koordinatsystemet. 
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12. Anordning enligt krav 10, kannetecknad av art den relativt snabba bestamnings- 
anordningen innefattar minst en rotationsindikeringsanordning (6) for rotation runt 
minst en axel hos maskinen. 



13. Anordning enligt nagot av fdregaende krav, kannetecknad av art berakningsen- 
heten (20) av tidigare berakningsresultat beraknar trolig position, orientering, 
arbetsriktning och hastighet en viss tid i forvag for arbetsmaskinens bearbetande del. 

14. Forfarande fdr att bestamma laget for en bearbetande del av ett verktyg pa en 
arbetsmaskin, varvid arbetsmaskinens position bestams pa minst ett agnat staile pa 
arbetsmaskinen i ett fast koordinatsystem, samt 

den bearbetande delens lagesrelation i fdrhallande till del agnade stallet bestams i ett 
maskinbundet koordinatsystem, samt den bearbetande delens lage beraknas i det 
fasta koordinatsystemet, 
kannetecknat av 

matning momentant av saval position som orientering av namnda staile hos arbets- 
maskinen i det fasta koordinatsystemet, och berakning av den bearbetande delens 
momentana position och/eller orientering i det fasta koordinatsystemet med hjalp av 
resultatet av den momentana matningen. 



av 



15. FQrfarande enligt krav 14, kannetecknat av placering fast pa arbetsmaskinen 
minst en detektorenhet (4) och en norrsSkande enhet (5b), sasom ett norrsdkande 
gyro eller en elektroniskt avkannbar kompass fdr momentan avkanning av arbetsma- 
skinens inriktning i fbrhallande till norr. 

16. FOrfarande dax lagesbestamningen sker med hjalp av en stationar mStstation 
(I;!*) placerad i narheten av arbetsmaskinen for lagesbestamning i samverkan med 
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detektoranordningen, enligt krav 14, kannetecknat av att den positions- och 
orienteringsbestamningen sker aniingea mot minst tva detektorenheter (4a, 4b) 
placerade i fasta positioner relativt arbetsmaskinen, vilka i samverkan med den 
stationara stationen ger positioner fast i rummet for sina placeringar och vilkas 
inbordes uppmatta positioner ger orienteringen i rummet for den del av arbetsmaski- 
nen dar de ar placerade, eikr mot minst en rorlig lagesdetektorenhet (33;50), som . 
flyttas mellan positioner med bestambara lagen i forhallande till arbetsmaskinen. 

17. Forfarande enligt krav 16, kannetecknat av vridning av lagesdetektorenheten 
(33;50) omkring en pa avstand fran den placerad axel (32) i forhallande till arbets- 
maskinen; matning mot lagesdetektorenheten nar den intar bestambara vinkellagen 
runt axeln i forhallande till arbetsmaskinen. 



1 8. Forfarande enligt krav 14, kannetecknat av rorlig montering av minst en styrbar 
optikenhet (26-28,23) pa arbetsmaskinen; inriktning av optikenheten mot den 
stationara matstationen med hjalp av antingen den stationara stationens matstrale 
£lkr en med denna parallell strale eikr en strile utsand fran optikenheten och 
reflekterad i ett prisma hos den stationara stationen; 
indikering av optikenhetens orientering i forhallande till arbetsmaskinen; 
berakning for bestamning av arbetsmaskinens orientering i det fasta koordinatsyste- 
met. 



19. Forfarande enligt nagot av kraven 14-18, kannetecknat av att matningen 
momentant av saval position som orientering utfors med hjalp av minst en radiona- 
vigations-antenn (50, 51) med mottagare. 

20. Fdrfarande enligt nagot av kraven 14-18, kannetecknat av att matningen 
momentant av saval position som orientering utfors med hjalp av ett geodetiskt 
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instrument ( 1 ; T) med malsokningsfunktion placerat pa avstand frin arbetsmaskinen 
(3) och matande mot minst ett mal, t.ex. en reflektor, pa arbetsmaskinen. 

21. Forfarande enligt krav 20, kannetecknat av riktningsanvisning for det geodeti- 
ska instrumentet betraffande det mal, mot vilket dess momentana malsokning skall 
goras i och for matning mot detta mal. 

22. Forfarande enligt nagot av kraven 14-21, kannetecknat av iniagring av kartbild 
med onskad topografi over ett omrade, som skall bearbetas i en berakningsanord- 
ning, och berakning av data for den bearbetande delen och presentering av det till 
lage och vinkellagen relativt kartbilden pa en presentationsenhet (9)(fig. 8). 

23. Forfarande enligt nagot av foregaende krav, kannetecknat av art positions- och 
orienteringsbestamningen utfdrs dels med en relativt langsam bestamning for att med 
tidsintervall mata den aktuella positionen och/elier orienteringen hos maskinen, och 
dels med en relativt snabb bestamning (ACC 1 , ACC2, 6), som reagerar pa positions- 
och/eller orienteringsskiilnad mot tidigare bestamning eller bestamningar fdr att 
berakna och uppdatera bestamningen mellan de namnda tidsintervailen. 

24. Forfarande enligt krav 23, kannetecknat av att vid den relativt snabba bestam- 
ningen: 

accelerationsmatning i minst en riktning, fdretradesvis i flera inbordes olika rikt- 
ningar; 

integrering av den eller de indikerade accelerationerna; och uppdatering av senaste 
berakningsresultatet av positionen och/eller orienteringen i det fasta koordinatsyste- 
met. 
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25. Forfarande enligt krav 23, kannetecknat av att vid den relativt snabba bestam- 
ningen utfors minst en rotationsindikering for rotation runt minst en axel hos 
maskinen. 

26. Forfarande enligt nagot av kraven 14 - 25, kannetecknat av berakning med 
ledning av tidigare berakningsresultat av trolig position, orientering, arbetsriktning 
och hastighet en viss tid i fbrvag for arbetsmaskinens bearbetande del. 
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SAMMANDRAG 



Uppfinningen avser en anordning och ett forfarande for att bestamma laget for en 
bearbetande del av ett verktyg pa en arbetsmaskin med en lagesbestammande appa- 
ratur (2, 4, 5, 6; 2, 4a, 4b, 5, 6'; 31, 33; 49, 50, 51, 1\ 53). Minst en detektorutrust- 
ning ( 4, 5, 6; 4a, 4b, 5, 6'; 3 1 , 33; 49, 50, 5 1, 53) ar placerad pa ett agnat stalle pa 
arbetsmaskinen (3; 52) for att bestamma dctta stalles position i ett fast koordinatsys- 
tem. Minst en lagesrelationsanordning (1 1) for att bestammer den bearbetande 
delens lagesrelation i fdrhallande till detektorutrustningen i ett maskinbundet 
koordinatsystem. En berakningsanordning (20) beralcnar med signaler fran den 
positionsbestammande apparaturen och lSgesrelationsanordningen den bearbetande 
delens lage i det fasta koordinatsystemet. 

Den lagesbestammande apparaturen innefattar en lutnings- och orienteringsmatande 
anordning (5, 20; 4a, 4b, 20; 31, 20; 51, 20) s£ att apparaturen mater momentant 
saval position som orientering av namnda stalle hos arbetsmaskinen i det fasta 
koordinatsystemet. Berakningsanordningen (20) omraknar matresultatet fxan den 
lagesbestammande apparaturen och lagesrelationsanordningen till att ge den 
bearbetande delens momentana position och/eller orientering i det fasta koordinat- 
systemet. 
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